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(57) Abstract: A controller for controlling the output of a 
controlled variable by using a control algorithm to which a 
modulation algorithm based on one of the A modulation al- 
gorithm, A I modulation algorithm, and I A modulation 
algorithm is applied. Even if the absolute value of the input 
value inputted into the modulation algorithm is kept over I 
for a long time, the control accuracy is improved. The con- 
troller (1) for controlling the cam phase Cain of an intake cam 
(5) has an ECU (2). The ECU (2) calculates the limit value 
deviation r2 for controlling the cam phase Cain according 
to formulas (1 to 10), modulates the limit value deviation r2 
with the algorithm composed of formulas (11 to 13) based on 
the A I modulation algorithm, thereby calculates the mod- 
ulation output u" as predetermined values ±R (R>lr2l), and 
calculates the control input Vcain inputted to an electromag- 
netic cam phase varying mechanism (30) from the modula- 
tion output u" (steps 5, 6). 
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r(k) =-1 • G • PREV02(k) (a) 

rl(k)=sat(r(k)) (b) 

5 (k)=rl(k)-u"(k-l) (c) 

d(k)=a(k-l)+ 5(k) (d) 

u"(k)=sgn(a(k)) (e) 

u(k)=F-u"(k) (f) 



KCMD(k) = FLAFBASE + FLAFADP + u(k) (g) 

r(k)tt^flSA*Sr, u"(k)H:3Eflffl*S:, G, Ftty>T>«r**l^4i*tTV^ 
So Sfc, sat(r(k)mSSfQ^$C-efc>9, *tf>1SWu r(k)<-l<7)i:#(£[*sat(r(k))=- 
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33<D0ffj££;^g£ttfc£iS#, IHSl1-^<b^to 0 Kftt*A5©* 

A{itSCaintD^i^i:(i, 7^^^—>^33W[Hl«j^g^*sUda(c:^j;5i- 

5<AT\ *rft£*H!tU #A#f|Cain&«Mi£fKll^g{t$*5fc*^*>5o 
[0054] »±©J:5tdS^^«BK*Affiffi B7*«l«30©ttf^4«tSHKWi-5 

c E5fcjjrfJ:3t^ «Bt*»Aftffi »raE«M*30-efi, #-M3:*ICaintt, »535 

oitmm^mam a d(m^mmm^tm\m^t55n<Dmxmmm^mt 

||Oft||^,$IJ^A^Vcain^^/>i-5^|^0^#W*AfeffiCain©j6^-r5gti^ 
[0055] rtlte, H6^1-J;9^, flH8*35#, ftJ^A^Vcain^WM^tl, m«8tfjF 
wiKlfiH-f 5. PlBK^MSfc, ««535©««^FsoH4, WA^Vca 
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[oo56] ^mmmm^^x, &±.<d Mtmmmwz, %t%<Dmm 

t^m£zm*-x\,^tK£2> 0 
[oo57] mm^^yb4(Dmm^Mm^mmm3ot&m\<Dmnmx hj* 

rr<tiCECU2(Ctti7Jl-5 0 

[0058] tit, ^y^y3CD^%m2(o^tiyh^m3^hrmimat. pr^mmb 

±yV2i&£T$^yi?^??i4frWirtbtix^^ 0 ^(D^%W^M!±^y^-2m 

&ffil/C, ^©^W{i-§"?rECU2^Ul7J-r5= 
[0059] ^Vv^n^l^i, ECU2/5^W$lJ^ff ^-(Cio-C$lJ^l$^> 

[0060] ^>-7>3^f4, ^7^^iryif22^|gtj-biX-CV^o ^7^^-fe>"^22( 

;<jVXit%Xh%CRK{t%te£TfTDCi$flrZEC\J2lZtiit)i-Z 0 
[0061] CRKft^-Ji, ffij£<D?7>?fi (W*. #30' ) r^l^/l^ffl#£ft3 0 E CU2 
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(4, rocRKff -f-fc/fcc, ^y> ; >3(D(i]«(^Tr^yv ; yiii$5ic:<bv^)NE^ 
*AffiffiCain«rHffl1-5o Sfc,TDCflHHi, #fcffi<otr*hynmMTgM*& 

[0062] ^*15©ttj|El|giKl6J:9t±«fli»itt, LAF1^t23«:tetu:v^ 

*©*W^JtKactSr«-r*W<B-§-S:ECU2taj*-t - S. ECU2f4, ^cDLAF-fe 

[0063] ECU2KU4, T^^&^V^A&XX^^-v'y^-^v^^X 1 ?^ 

G-SWjfcV»5)25^85«*tfCV>5. rcDT^-fe^WSiryf-24^ 1*^^ 

U2{^ttJ*1-5o tfc, IG-SW25f4, 4?~y*/3y*~m^-?)%kmMON 
/OFF*n5itt>fc,-t©ON/OFF^IB**1-flr*S:ECU2K:ffl*1-6. 
[0064] ECU2f4, CPU, RAM*$J:t*ROMfci?a»&&5-r>f*n 

3^lfa-^«^^rfe9^^Lyt*ao^^20-24Ottffi^-^*3<tmG 
•SW2500N/OFF|f^<b'(Ci^CT,^y^30aife^^lJSiJ-r?)i:^(C, 

[0065] fcfc, *&Jtofc«-T?W\ ECU2tCj;i9, H^ffi^ BltS^, fflffllt 

[0066] E7{^1-J:5t> frJMttm, 2^S^7^T-V^^-K^^hn-7(WTr 
TDFSLD=iyhD— 7J<bV^)40*5j;tJ ? DSM3yhp-750^1^T*3 | 9, 

d-740, 50(4, Mcftmax ECU2fcJ:*)1flfitejirv^ 

[0067] C©TDFSLD=yhB-940(ftHlP|l3lW#a)tt, *AifcftCaIn*B«*Aittffi 



WO 2005/015325 20 PCT/JP2004/0 11442 

J:t>*I^^A^Cain_cmd(k)^DT, #^A^)r(k)^ttl1-5 0 >Wb\ 
[0068] |SIiao#S:fc*JV^T, lE#(k)##0#«tfC7 f -^f±, Elr£Jl$T*1^7 ,> y^£ 

ii#^ltv^„ w^.ff. sE-^k^iu^if^yy^^^-ef-^yy^n 

TbIPItRtffcS, fc*5, $lT<DmWX*\t, #««7 f -^fci3Jt5ffi#(k)SrJSl:^fl& 

[0069] |W]|Ho^;(l) [^-f=fc5t> w©$iJ^iT;v=fyXAX14> #H A^r (k) |i, 

(k) , #lJigiJA^rrch(k) s iiJ^MA^radp (k) &£&tfWV>? 
A;fcrdanip(k)©|&ftfcLTjJffi&h£o 

[0070] i©7-r-K7*!7-KA2jrff (k) tt, fl*IBWR£'<5p«-*POLE£, S M*J± 
&fa<074>V#^<r>&%n^9Cam_cm&_i{k) , Cain_cmd_f (k-1) , Cai 
n_cmd_f (k-2)i«rffll\ ^(2)ja»?|fffl**U5e :®§]|WtS^7^P 

oLEfi, -l < pole < ooHttWA+attfcttjeasii'is. 

[0071] B^AfttB07^W^ffl©^lHlffiCain_cmd_f (k) (4, -^OituHMitCain 

_cmd_f (k-1) , @ AffiffiCain_cmd(k) tSXTf S /I'^lttJE'W- 
*POLE_ffcJBV\ *(8)fcJ:«?3ffttl&ix3. :c5lit7^S^MPO 
LE_f(4,-l<POLE_f<POLE<0cD^^Sr-f5fjt(c|g^tL5 o 

[0072] ilJjgllJAJJrrch(k) fit, £(3) t^JSt, fOai^-K^S^ 

^Krch*Jj;t>*»rJiCas(k)<DairtX»W^ l^JMMfc a s (k) 5$(7 

)fcW3ltil^fcji^^e(k)^ S(ri6tfc«JjftB8W9:i6/W-^POLEi:Srffl 
v\^(6)W;i9^tB£ti5 0 
[0073] jg^IlJA7Jradp(k)«, it(4) KjfrfZoi^ ajSflfl^-f-r-W* 

A^rdamp(k)«, *(5)JC*1"J:5K, fa-It, ^tV^^-KVV^-lVKda 
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mpt,^Mtn(D^\B]mmm$.tomMCam(k)-Cam(k-int(DmtLXW- 

[0074] U±<DTDFSLD=>bv~?40<Dm&TA'=rVXMZ&tltf, K7*!7— KA 
#rff (k) HUtf, ii#P©J&Ste«:fift, ^AflSCain© @^^Af4tBCain_cmd 
^©lK*«£*i«fcSr*aSt!#5 B §U^fllJA^rrch(k)*3«tU5jg/SIlJA^ra 

[0075] U»U 2 1 S^^rV^^-K$iJ^Ty^yXA^J;i9»ffl$^fc#^A^r ( 
^LT^tB^tvS©-?, # AfifgCain© g ^#AfefBCain_cmd^©iit£ff!iJ# P£ 

£5irf *il^|SCainrt*-e-ilH^bt-Ct*V\ a«JfcfW«Ii-Swi^t?lr 
*V\ 1-fcfc>^ ftil^fitCainrtW-jfi-e, *A{i^Cain^>^{b*T^Pl- 
«OdSfflH^*>5 8 iftiRBfc, ^iNfi^Cain^COftii^fjgCainadJ:!)^^ 1 , 
«afll©ttfflT?*J8U:5fc1-5i\ ««Cainad;r?-M^{fcLTLl£V\ ii 
#WW1iP^5rfctfT?#&V\, f *fc>*>, ftjgftfflCainad#iS-efe, #-MStfBCain 

[0076] ^±rogsK:«w x ^7-rxVy^-K$ij^pr/^yxA^tfn/^h$ij^T;^ 

ainSr, ^^3i^OjiVNg^i=sMCain_cmdtCii^^Sii^ftlJ^^, MSJ: 
<*tTl"5-i:* s BJt-ca!)S. 
[0077] Lfc^o-C, ^HKfiTii, # AfltfBCainS: g $^{]itgCain_cmdi£i6t£$ 
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mtl30-^)ffilJW Vcain (k) £H ffi-f5 0 
[0078] WT\ DSM3VhP-750(f|!iJ^iil»ffi^. MA^^tti^){-oV>Tlft0J 

SrySyMfcSLfcWIRfcrl (k) ££#50b(ff£*iil#&) (HIP 

fifi:>LTro*JPSjia-(i^r2(k)^\ ffflffifitrl (k)i, *7*yHK*£»50c!&»e>©Br 
^©^7-fejyhfllVcain_oft(»l*5j:V!B23fSffi[) £©{l^LTM£ftSo £b 

u" (k-1) fc©flRSfcl/Cffl|gflr-IHI 6 (k) #M£ft5 0 
[0079] ftv^tf, SKHB50fK,M, flSHflf^Ht a (k)#, fiMft« 6 (k)t, mmmft 

miAbLxoimmwMtK ®mm^a.o (k)\m^xm^m+R/-Rt\. 

TM£*i5 0 *fC, lt*i«50h^«tO, W^IIu(k)ii, £WfcU;*iu"(k)* 

JM&5OifcJ:0, Sy»A*Vcain(k)#, WsW&foiM b, ffl»Lfcfll*«^«5 

[0080] rODSM=»^hn-750©MT^rfyXAtt, |I]10<D5t(9) - (l5)T*^$ft5 0 
i©S:(9)fcteV^ Lim(r(k))f±, *Ji&A#r(k)&±fEy5y*50a^y5yH&JlL 

±ffitoax^^$n5«£Hrt{-*JlfiLfc1ittt-C»ffi$ix5 0 r(k) <r 

minOi:#jc:ttLim(r(k)) =rminy«C9, rmin^r(k) grmaxCO^#^fiLim(r(k)) 
=r(k) Met), r(k) >imax©t#^{JLim(r(k)) =rmaxi/^S 0 ^tbk^TKifrmi 

So 

[0081] xSC(13)tdjoV^-C, fnKff (k))tt, JblEyu— ®3fl50gtC*H S ■rS*iWH^B8 

SrCfcO, -tOflltt, a (k)^OOt#»Cttfnl(o (k))=R£fcD, a (k)<O0i:*K: 
ttfhl(a (k))=-RWfc*0W3, a (k) =0©fc*fctt % fnl( a (k)) =0tfR£t/Ob 



WO 2005/015325 23 PCT/JP2004/011442 

Mo tit, i©#KB\ ®j&t&m&fc£0, R> I r2(k) I ©HflWSUffcJEftAI- 
[0082] ***^ffiODSM3>'hB-950©ftlJ«IT/UrfyXAJ4, £JL_b<0 J:5 KlfllJEft^tbT 

^hp*-750tS:it|SEl- Si:, ^©3yho-760T*fi, a65MH60bteJ;t), U^60a 

&<DWK DSM3^n-750H^LTS4o-C*3«3, *©te©i£H:P«Sfcft/j££ 

[0083] r©3yhn-760©f|!lJ^T;^yXA(4 N E|120S;(16)-(21)-e^tL5o 

S;(16)fc*V»r,sat(r(k))fittfIlBB«rT?&9, -t®ltf4,r(k)<-l©i#tettsat 
(r(k))=-li:ft^ -l^r(k) ^l©^fct4sat(r(k)) =r(k)M«>, r(k) >l©t# 
fcfisat(r(k)) = l4:*5 0 

[0084] S:(19)fcj3V^8gn(ff (k))tt±E*?M60efcffiS"t-5«F*B8» 

"CifeU, -tOtttt, a (k)^0©£#Kfisgn(a (k) ) = a (k)<0©i£Wis 

gn(a (k))=-lWe5(fc*3, a (k)=0©i#{C > sgn ( a (k) ) = O^tLTbiV >) 

0 

[0085] £©3VrP-?60*rJBv\fc*£, Bl3fc*-*-J;5K:, #fi8A^Jr©iffe*fffi^i[lJ: 

-ltfiytosjis^-c, SBnawwu iai*fcttii-ifc««ten«i*M*ft<*«) 
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[0086] Hl5lC^i-J;5fc, *^JfeMOTDFSLD3>hn-^40^J;ip^£tl^5 % 
{*f@Cain£ g A^|gCain_cmd^j@tS$-&5/t*0#J'a A^r-ett, 

wuHitri , *«, iti*fcttit-ifc*<fiy»sn«!R<»* J »4-*-5ifc 

"C\ MA^Vcain^ 0f^^SAfi^cainmaxl^fcf4Fjf^©ft/J N fi^n/cainmin 
U!ifi<»«rSii5*tffi*s»4-r5(tl*-t2, t3-t4fti?) 0 tf-MfcftCai 

33bfc«£U «**fcir;WS£l/CL*3. 
[0087] rJUdftbT, *«ff^©DSM3^hn-750Tii, *^b^60e1-&fr^ 
-§-§@$tsgn( a (k)) W^T, Stj^Lfcyu-^50g^|P^^WMi5:fnl( a ( 
k))Srfflv^tttfc,mifitfc0f3tffiR^R> I r2 I <D&&ifi%iZf&iLlrZ&t£ 

[0088] Sfc, DSMsi^P— 750H$8Vvt\ $lJPSitrli0r^cD^-7-tr5/MliVcain_oftt 
©«S|-e*5WISItfllJftr23&^ IS##50dfcA^&»x5i:*t>l^ ftJfPA^Vcain 

ho 

[0089] -f*fe*>, W&Ltc£o\Z. s «Bt*&AffitBBrag«M«30©ma*'35Ji, ^©m^ 
^FsoW5$ij^A^Vcain^iOd^iEtJ^ii^1-S^^^,»^AIII^»t- 

<D-jj<DUbLX%tti-fZ>!&mSh?><nX, *H3S^^OTDFSLDnyhP-740 
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ffifflts IEffl{|iJ(7)0f$$5H (rmin-rmax) (CgS^^tlTV ^ 0 
[0090] Lj5»U r<7)J;5^^JPSttrl^t{-2EffitfC»ttS$tL5^{l*5V^-r, dtifc*© 

(Z>DSM=iyhn-750-ef4, ^^50d^A^^S$lJPIjiliMr2^\ WSfiSrl^ 
^*yH^caii^_oftiOfl||ltU-C3lffl$n5fc«>fc, r©#J|R«[fi||Sr2aS3E 
tt^fKOM^^I"^^ y5s/^50aW±TPSfltrmin, rmax$d£Xf*7^yh 
f(Vcain_oft^ x mwMZ&mztix^Zo mtiO, 0l7^1"J:5t, KM 
th)^u"«, ft*itl«:ft/JHII-Rt©IW-^B*K:Ste-fSttt>t, ft*filRiU~-<£> 

[0091] mfciP^T, llffat^5*lWftAAVcainOW#©K(BSriaaii-5fci{) % 

-fe-yMfiVcain_oft^J;M*IMy^>KDSMtt, $IJ»A^Vcain^, Vvj-fyfc 
jEfM>, j^£©ft*lTVcainmax (126*1$) <bff^©ft/J^IVcainmin(il6#{!S) 
t©IW^Sfi*||9igi-J;5^«^(KDSM^l) tW!£$jxTV^ 0 fc*S, 1216 

[0092] £Jl±OJ:5'Wli!lflIT^='yX^»£j;?) % DSM^yhp-^SOT'fi, TDFSLD^^hp 
-940*>fe©#llBA*rfca6-3# % WHPA*Vcain#J|ttllSil5i:ir|>fc, **l#m 

Hl8fc^J;5K:, #JHAAr#ft#fcH»Ufcfc*-efc, *©1WIMtrl#nnin 
irl^rmaxtttfeSHSwfc-e, fOTA^Vcainfi, ftAiitVcainmax^/MiSV 
cainmini:©|RJ-ClB*tR*ii-6fc«>K:, *0>g|E£&aS¥* ©f fl^Klja^JS 

fflj:<fliij«i*nswfc, iPJHfc*-r«t5t» mmnmamad*tzi*Mm%mamr 
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m-r 0 sxrm\:)x\ mm&*Mm^mm®3o&iE%x*hzfrm*mm-fz>o 
z<Dmiw$k&YEsx\ nmttMm^%mm3otfiE%x*hzt%Mx ^y 

•fZKM^ ^V'JVteWXhZfi^-h^mi-ho ^<D^m\it, IG-SW25CDO 

[0094] ^<DXTS?2<DWmW%:tfNOX\ ^y'y^MhW^Xh^km, ^ryv° 
3\ZM^, g^#i«©^y:/ffiCain_cmd_map£, ^yVvW&WV&k 

[0095] I^JEIWoV vC N S*h^TRQ©^r^ffiTRQl~3tt, TRQ1 >TRQ2>TRQ3 
^ftCain_cmd_mapii, 3:>"^ygHakNEiJ«ffiV^e4f % 3=fc{2g#h/WTRQ 

[0096] ^(C^r-y^4{Cji^.^r2/^3T*#ffit/c-rs/7 0 fiiCain_cmd_map^, Sffl 
*AffiffiCain_cmdtL-C»^L, *0>8U XTyrtizMfr* mfi$Lfc:£(l)~(8) 

[0097] *t^6^^ lW3fiUfcS;(9)-(15)OlW«iT^yXAtJ;i3 % M 

A^Vcain£»tBUc^ *^n^?A«r**T-**a. 
[0098] X7 i S /7 P 2©WJ^^NO-C\ aiy^y^s&'fC&Sitttt, TfryfVz. 

S«{#AffctICain_cmd<S:> 9f3e©*&«ll*ffl*[Cain_cmd_stHKS-t"S 
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[0099] XT^KDwrn^Ko-^ mmttMm^mmzotmwLx^z 

[0100] £X±<D £?'<Z, *MMWM<D f|ilj«gl fciftfi* TDFSLD3yhp-y40{Cj:l9 
h5>mmMM.T2fi\ A Z^iiT/^'yx'A^S^<T^'!JXA[^;(ii)-(i3)] 
[0101] r©ct5i-> $iJPl{il:rl^iEfiS^L-C»tll$tt^©^^ ^ft<t^:71?s/MiSVcain_of 

V\R> | r2 | bteZ>lbtimz-WLlZ£KZ><DX\ f$\fe\$R, y%yY%m<D ±TPSfltr 
min, rmaxfcit/^-^-ir-yMilVcain^ft^ig^K^^I-S^i^J: 1 ?, #{§A*r 

^te^«m^4c^ii>LT^i±ix*t, duff « 5 tfrnm^m®. &m 
tiz><D*®mx%z>o z<d&^ muuwt:, ^m^imtm^m-Rto^x 
(DRm^mm^m±t^tth^^imm^<D^mm^t^m-RM^(OE 
mm&ttf** m^ft^kvmkLx&m-r^kfrxz, mfflm&*\a\± 

£MZ^ktfX%Z, 0 

[0102] £fc, MA^Vcain;^ «aj^u W^MUfc^y^Mut, 

yM(Vcain_oft^0^-f"5^<ir^J; l 9^W$tl5O'C\ rc0^7-iT5/hilVcain_oft 
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(DMM-'iM, ftJ^PA^Vcain^ j^cDEOft/MfiVcainminift^IVcainma 

[0103] *AffitBCainSraE3E-f S»»fcL-r, «8S^AfiWiT^||MS30«:ffl^ 

j&*Bfc#o^:fc<, iBlbliW»fe*^*B(^inSrai«]»!:fW«i-t't5i:itK^ 

[0104] 4*3, %immjtmit, m^50dmm^ti^mmti<Dmmmu"(k-i)t^ 
u" i =r> i r2 1 i^±i-^o\z)nmuz^^mmmn\-rfiw)^ 

mmn\irt£t>hyi'~^mogWXx.x. ft%mto^xm%V4v. t-*fc 
hm^im^iumm^um^t>^xm^b\zx^)^mtiitiu't:±B(DX 
otmthxn&Lxh&^o 

[0105] Sfc, TDFSU)=^hn-940tcJ;9»ffl*n5#l»A*rOiieSt**Sffl[lSrje^ 
ftv^i^ DSM=yha-950©JJ^-»*50g(-r*t)*»*II^H»fnD 

in_cmdfc*J:U^J»A*rtSV^i'nfcAllfcLrJ|[ffl$nS*&-, tf^-feyHUVcai 
n_oft£fc<lItel/tfS!£U IWWA^VciiinSr, %m\(Dmfemmft<Dfrxm\:i- 

[0106] gigjftgffitt, ««**-Mft«Rr3E««30Sr, »ft*A5©*-MiffiCa 
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_cmdKft5J:5fcW«l"t5fc«)©1Wftir^!;XAf4, »l^lfe^«g©2S 
<fcv\, 

[0107] fcfc, H2lS:#!lBUcise>, *2HlfiJgffi©fW»iSfllK:ov^M't5o PIBK: 

mis, ^(DSDu=iyhti-y7o(mmimm^^ nmwxft^&oit, s a 
«7/w<;xA£ififfl ufciWftr^yxA^o, tdfsld3^d-74o*»?>© 

#J?8 Art r (k) iCg^V ^TfMffil Art Vcain (k) SrUffi-f 
[0108] 1-4^*), rOSDM^yhn— 770T'tt, TDFSLD^ho— 740*»t>©#HBA 

rl(k)#£j£&h,, fcfc, ^S70b«BH»tb¥S)t«tt), iJP5ttBMr2(k)^, 
fWPSISrl (k)<b, ^7*yHtt*4SP70cd»f>©glf€O^7-feyh|ttVcain^_ofti:© 

#fit a r(k)^\ $lJMfe"^r2 (k) £{gH^IcDi§M a r(k-l)£©fntLT£/& 

ffifti®. a r(k)t»|ijrt«#ffi a u"(k)t©iHISttT^G*nS. 

[0109] *V^, y^-^70hKU;^ »ffirtu"(k)^ ffi£f&#ffl: 5 (k)K:S<5^TBf 
M+R/-R£L-C£j&£ft5 0 *UT, *69ttt8&70Hc:<W % $V:4JJSf£u(k);&s, g 
Wffl*u"(k)«r^*©fi«||tty>fyF(=KDSM)^^yP«ELyt«[fct-C^ 
&ft, aPjH»70jfcJ:*) % (W»ArtVcain(k)!8S, ^yiifu(k)aEt7 
■feyMgVcain_ofti:0?tiiL"C % £fifc£4i3 B 

[0110] £t±©SDM3^hia— ?70©W1|pT^yXAtt, H22^-r5>:(22)-(29)X 
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fflCtBLfeZtlX^&a £(27)©2M*JBH»fnl(6 (k))fi, 6 (k)£0Oi# 

tcttfal(6 (k))=Rifc5, 6 (k)<0©t#^H:fnl(« (k))=-Rt**J:5fcK^$ 
tfCV^(*fc\ 5 (k)=OOt#K:tt,fnl(« (k))=o£3*£uoi><k^)o 
[0111] Sfcfc, m&LtcM&KM, ffifemtt. R> I r2(k) I ©BWRAS^fc^lCfSJ: 
5fc» iUJ^^VH^&Jfc&h/t^So Sfcfc, S;(23)^7-irs/MtVcain_oft 
*3j;t>*i(:(28)cDSgi|)IM^-('yKDSM i b ; e^m> U(rJfiLfcJ:5K:, BWA^Vcai 

[0112] ^±(DSDM=yhP— 970t<ttltf, Mi^tfeDSMayhta— 750^IHfilH, $lj 
M A^Vcain (k) B^^IE(Dft^fiirV'cainmax^/J^jilVcainmint(Z)^X: , M 
StKlKte-fSfctfcl!:, ft^ffiVcainmaxilJ^WS^itt^/JMitVcainmintlJ— 

wOTM^^* ©#J^lcifi-5<J:5*«fctT3im"tSiWS-C#<B. W&$k. 

[0113] fcfc, 023&#ilBLft#e>, *3|£te«ffiOW«lS6ttlB»toV>-CKMi-5. 

tt»lll*»t»©fWlP16aifclBI*fc«lJ5teiirv^©*C, lfti||*€l»i-* B r«D 
M=»^hn-980(«iJtWII»l±i¥a, ffl*lPA#3Sffl¥IWWu AagWT^JJXAS: 
mUtMfflT/l'^yXMZ&V, TDFSLD3yhn-740^^CO#B^A^r(k) {Cg 
-31/ ^#J»A* Vcain(k) Z&tiitZbO'Z&Z, 
[0114] IHHiC^-f r<Z)DM=iyhP— 780"Cii, TDFSLDn^hn— 7 

80afc«Wf&IP5flrl (k)#*fcjfc&H, il#*80b(iIig#ffl3MS:){;:«W, » 
MMr2(k)#, WSttrKk)^ *7*yHIB6^<B580c!8>6©9f*©^7"tyMi 
Vcain_oftfc©fi5£iLT3^i**lS. »^80cU;^ gBWHJ^SHHS a u 

"(k)^, mMm*80exmmzhtc£fflthtiu''<k-i)k, ^mmtsm^m^Mmm 
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tons] })i/-mmog\M, &mtiMu"(M.)tiK mm^us^zm^xm 

fcfc, JPJHB80ifcJ:9, WJ»A*Vcain(k)is, WI«u(k)i:ilEt7 
-fe5/hfiVcain_ofti:©fB^LT, ^$tl§ 0 
[0116] J^±(DDMnyhn-780(DMT^yXA(i, 024^^(30)- (36) X*%&fo 
5 0 ^(7)S;(30)(Z)35iJPg1iSLim(r(k))ii, a&aLfcS;(22)©'t)Oi:iaiCWRIMIK:K^ 
SivO*. Sfcfc, A(34)©^iH^B8ftfnl(5 (k))t>, StrJ6UfcSS(34)ofc©i:IBI 
fctefOR£$*LT^5 0 t-fcfrt, 6 (k)^0Wi#fcttfnl(5 (k))=Rifc0, 6 (k) 
<0©ttfcttfnl(fi (k))=-R^5J:5^S3£$HTV>5(*fc\ 6 (k)=0©£# 
fctt, fnl (8 (k))=oa££L-PU;^) 0 

[0117] m^Ltzm^M, mmmuz. r> I r2(k) i omms%fctf&i-?>£ 

{ilct^^^i/MIf^^tL-CV^o £ibfcs SC(3l)©^-7-fes/HitVcain_oft 
joct^^(35)W^i|iPS^yKDSMfc^tl€tl, Htfe&LfcJSfc, WWAAVcai 
nOft^Ktefclilitti* ffifcaw^ (KDSM ^ 1) fcK fcSivCV ^ 0 
[0118] ^±©DM3^ho-780HJ:tltf , M^LfcDSM^yhD-750<b[Wl#(C, Mftl 
A^JVcain(k) £ % fjT^©iE©ft^{jiycainmax^ft/J^ilVcainmini:C»^"C^^ 
KStefStirfcfc, ^^ffiVcainmaxffl^coSte^-StS/J^fiSVcainminiliJ^© 

[0119] fcfc, B25«r#HBUta*e>, m4*»ffi©$ij^g{cov^0^-r5o PI Elm 

ttaa*JtKact(Wfl|^©|±l*)SrW*-r5*Jcfiat'a. SflflPgfilC 
tt, 2g ft^^f^f^^- K^hP-^O, DSMnyhp-ygi, S*^* 
»ffl^92,^»§§93fej;0i^^Jt*Wg|594^{i^rv^o 
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[oi2o] i©a«^«jtj|Lffl»94(Baiifia»^a)m ^svmmtiEte 

iXm%f fomttJ£PBA\Z.foVtc-?y7&mte¥ fciO, I «S£j&JfcKcmd ft 

[0121] 2S S«^7^^*-K3^o-990(#J»Wffi#a)"Tftt, BfS£ 

«iltJ|[ffl»94"T?||[tiiS*LfcB*2j»itKcmdi, &Afcm¥8tkLX(DLAF±> 

[0122] £^ DSM^^hD-ygi wmmntti^tk, mmAxmwx^ 2g & 

^yXA^^<^T/^yXA^«ti9, M»A*iLT©j»i»*tjE|iKAF (k) # 
nttiZtiZ. ;oiMjEttKAF(k)H: 4 Sftit!«lfl[iL-C||CHiS*T/5. 
[0123] wODSMaVhn— 991©<MtPT^yX^tt, AftWHW:, itf^tfcDSM^yh 
p-?50©fc©fc|Blfcfc1*j*&h/tvs5o 1"&fc>*>s H25ti5%i-J:5fc % DSM^yh 

p— 991"t?f±, 2i *a^9>rf f -fy^ i E-*-K3yhn-990*»e>O#lA*r(k)36Sy 

5s/hMaUc$iJPIjirl(k)^^^ ^#£9lb«SH3fffl3M8:)f::«W, SfllSfii 

cmd_ottt<DmnkLX%.f&£tlZ 0 Sfcfc, HM91dtJ:»5 % r©f&JI8fMIgr2( 
k) £Mi!f^91eT«£ftfcMa^u" (k-1) fcOflSHiLTiH^9 « 6 (k) 

[0124] &v>-? % a^«9if ><m, mmmuM o (k) ^ mmwm s (k) ffigftg- 
mmtiu'ik) tK tommftmo fc)K£^xm%m+Ri/-RikLx£j&zti 

5 0 r©BW£*RlM\ jtu^LfcSEfe^cW, Rl> | r2 | ^^^^§±5*, fill 

Mffl^u" (k)^Fjf^ws*§p^^yF-ey-r^«tfcffiitT«$tL, 
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[0125] ^±<DUm7JU^JXMZ^X, *7±vb{$Kcmd_oh(%ilid£Tf%2mfeiU 

[0126] g»M||ffi^92Tii, ^^^IsI^^NEfc^t/Piiatrtffi^/fPB 

6 0 ^LT, *^93^J;D, M"AWl:Tout^S«!|s(.i;Tibase^m^iEjif 

KAF(k)^r^»Lfdil<!rLT»ttS^^c ZLX, ^MTOSTout^tftW 
ft^^^x^l4^^$tl5*^tJ;^^y^^^l4(7?^#B#^^$iJ^^ 

[0127] eil±©»4|llKjg«OfW»i6illCtJ:tLff, B«^ltKcmd*sy-^ffl^»b 
yyfH«fcfc»^5jK|6H©fl[(W*.fi^ftitO. 7-1, 2) KKfcSft*::^ tft 

(D^"7-feyHfiKcmd_oft, ^if'lRl^^V>'FfeJ;t) ? B^^lSRl^jS'SI^iS:^i" ; 5^ 

P>9f^«SBBt?Seii1-5t^f^ ttWS*RJtKactSr I *^JtKcmdfc*»«J:<JK 

[0128] &±.(D&mMMmiz, *%w<DMmmwz, xMmcamzmmtzbo 

fc$rfctt#5£-efcftV\, #St7)3^hD-740, 50, 70, 80, 90, 9l£, II 
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•\ 

^xnmtmmmm^t, 

^xwtti-rzfflmmnm^&t, 
ma, 

[3] afl^fflflwiu!), mmmnmmti^mmi-mmmwixh^x 
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fcfcfefc, flfflS£flHK$\ att«»li[olfe»«asffilJ:?)t*#v^3t|i[fc/iSJ:5k: 
[7] rt«KWHO!R^*^ itW^C^Sr-tiT^etLllll (H«fe«>©!»*Wy ^33 ±ue»ftt 

tflE*^latrf&J^1-5fcfc(D$iJ^fi^,Bff^^iJ^T/^yXA{c£^VNT^ 
Ettto -Mttti Hr*««^©l|iiJ«i A* W-t-5#J* A* » ffi Mi s 
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&jvrv ^ ttz>m *ii5^v ^l7cdv ^-rti^mmmmmWo 
[9] nmtt&^v>umxt)\z.xy), mmmnmm^BWMKt^mmmi- 

[11] rtilBBC^#fcJ:^#Hn?nMMt5fc*roK^^OTft 

okmrn-tzMwrnw-xh^x, 

■tzbbh^ mmmtitfimLxv^^iat. ^mmfeofawzmfe-tz- 
^(Dmmmmn^nm^Mm^mmb, 
mm^Mmmm-r^Mm^ia^b. 

^m%^titzmm\$.bmmmtb<Dumn\^^umMm^b, 
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[137] 



40 



50 



Cain(k) 


2 gffiS 


r(k) 




Vcain(k) 


► 

Cain cmd(k) 
► 
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[198] 

r (k) = r f f (k) + r r ch (k) + radp (k) + r damp (k) (1) 

r f f (k) = Ca i n_cmd_f (k) + (1 - POLE) • Ca i n_cmd_f (k - 1 ) - POLE • Ca i n_cmd_f (k - 2) 

(2) 

rrch(k) = -Krch-as(k) (3) 

radp(k) = -Kadp-I as(i) (4) 

i=Q 

rdamp (k) = -Kdamp • [Ca i n (k) -Ca i n (k- 1 ) ] (5) 

as(k) = e(k)+P0LE-e(k-1) (6) 

e (k) = Ca i n (k) -Ca i n_cmd_f (k- 1) (7) 



Ca i n_cmd_f (k) = -POLE_f ■ Ca i n_cmd_f (k- 1 ) + (1 +POLE_f ) • Ca i n_cmd (k) 

(8) 
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[BIO] 

r1(k) = Lim(r(k)) (9) 

r2(k)=rl(k)-Vcain_oft (1 0) 

«5(k)=r2(k)-u"(k-1) (1 1 ) 

or (10* or (k- + 0 00 (1 2) 

u"(k)=fnl(o-(k)) (1 3) 

u(k) = KDSM-u"(k) (14) 

Vcain(k) = Vcain_oft + u(k) (1 5) 
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[E12] 



r1'(k) = sat(r(k)) (1 6) 

<5(k) = M'(k)-u"(k-1) (i 7) 

(j(k) = a(k-1) + <5(k) (1 8) 

u"(k) = sgn(a(k)) (1 9) 

u(k) = KDSM-u"(k) (2 0) 

Vca i n (k) = Vcai n_of t + u (k) (2 1) 
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[115] 



Cain cmd 



Cainad — ■ 



Cain 
(Ca i n_cmd) 



-Cain 



Cainrd 
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mm 



c 



START 



SI 



NO 



YES 



YES ,S2 



D 



NO 



S3 



Cain_cmd_map ^{ij 



,S7 



Cain cmd «— Ca i n cmd st 



,S4 



Cai n_cmd<-Cain_cmd_map 



S5 



Vcain Utti 



,S6 



i c^i 

Vcai n<-0 



( END ) 
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[022] 

r1(k) = Lim(r(k)) (2 2) 

r2(k)=r1 (k)-Vcain_oft (2 3) 

ar(k) = ar(k-1) + r2(k) ( 2 4) 

au n (k) = au"(k-1) + u"(k-1) (2 5) 

<5(k) = ar(k)-cru"(k) (2 6) 

u n (k)=fnl(d(k)) (2 7) 

u(k) = KDSM-u"(k) (2 8) 

Vcain(k) = Vcain_of t + u (k) (2 9) 
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[H23] 
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CH24] 

r1(k) = Lim(r(k)) (3 0) 

r2(k) = r1(k)-Vcain_oft (3 1) 

au"(k) = au"(k-1) + u n (k-1) (3 2) 

<5(k) = r2(k)-au"(k) (3 3) 

u"(k)=fnl(<5(k)) (3 4) 

u(k) = KDSM-u"(k) (3 5) 

Vcai n(k) = Vca i n_of t + u(k) (3 6) 
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